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Device and method for determining the position of a working part 



5 



The present invention relates to a device of the type stated in the introduction to 
claim 1, and a method of the type which is stated in the introduction to claim 14. 
The invention concerns particularly the controlling of an industrial machine, for 



example a ground-levelling machine, crane, dredger or the like. 
Background to the invention 

During road construction or the levelling of ground, for example for buildings, parks 
10 or playgrounds, vehicle displays or the like, ground preparation machines are used 
which are to give a predetermined topography to the piece of ground through, on 
one hand digging and on the other hand piling up material. 

It is important in this connection that the working tools on the machines which are 
15 used can be accurately controlled to the exact right working level in the intended 
section. The control should preferably even be able to be remote-controlled 
automatically so that the desired topography in the right position inside a section 
should be able to be written into a computer programme and information concerning 
suitable processing should be able to be given continuously and automatically to the 
20 driver of the vehicle. It should also, in the cases where it is possible, be able to have 
automatic controlling of the machines in order to perform certain work completely 
automatically. 

This implies that for ground-working equipment one needs to keep track of the exact 
25 position in space of the working tools' positions in space, the angular position in 
both horizontal and vertical directions and their working directions. 



30 



Description of related art 

US-A-4 807 131 (Clegg Engineering) describes a ground preparing system with the 
use of an instrument with a horizontal plane-identifying rotating sweeping beam, 
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and a height indicator placed on a ground-preparing machine, for hitting by the 
sweeping beam. The height indicator is placed directly onto the working tool of the 
machine, for example on the blade of an excavator. Furthermore, a separate position 
generator can be placed on the machine and cooperate with an electronic distance- 
measuring instrument in order to give the position of the machine in the region 
which is to be treated. The signals from the different above-mentioned indicators are 
fed to a computer, which is given information on the desired topography of the 
region of ground via predetermined, composite data, and which compiles measuring 
values and gives indication for controlling the working tool of the machine. This 
arrangement with the position sensor on the machine and the height sensor on the 
blade does not solve the problem of determining the position of the blade in a fixed 
coordinate system, which is also pointed out in US-5 612 864 (Caterpillar Inc). 
According to said patent the problem is solved through two position sensors being 
placed on the blade, whereby the slope of the blade in one direction relative to the 
machine is measured with an angle sensor and the orientation of the machine is 
extrapolated out of the measuring data taken during movement of the machine. 

Placing the position detectors on the blade, however, implies two large 
disadvantages: 

A. The detector or detectors are sometimes obscured by the machine if they are not 
placed on high masts, which reduces the accuracy and reliability. The detector or 
detectors must, however, be able to cooperate with a measuring beam, no matter 
how the machine twists and turns during work. 

B. The detector or detectors are extremely exposed to damage during working, dirt, 
vibrations, mechanical damage, etc. 

To determine the orientation and inclination via machine movements is furthermore 
a slow method and it is not unambiguous if the machine can reverse or move side- 
ways. Likewise, position- and height-determination with the aid of GPS-technique 
or with electronic angular and distance measuring often is not sufficiently fast in 
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order to be able to measure the position and, above all, the height with sufficient 
accuracy during fast displacements. 

There are other types of systems which concern remote controlling of one or more 
machines in a working place with the help of several geodesic instruments. Each 
instrument can automatically focus on and follow a reflector and give information 
on distance and angular position to the reflector in both the vertical and horizontal 
directions. It is then intended that the ground-preparing machine receives position 
information from only one of the distance-measuring instruments. In this case it is 
intended to discriminate away the information from the others. 

The international application W095/34849 (Contractor Tools) describes such a 
system where there is a horizontal ring of reflectors and where it is possible to 
controllably use only the reflector which is directed towards the distance-measuring 
instrument which is to be used in each given moment. Only the coordinate position 
of the machine is measured. 

The international application W095/28524 (Caterpillar Inc.) shows the controlling 
of a number of ground-preparing machines, where the actual position of each 
machine is shown with the help of a position-giving arrangement, e.g. a GPS- 
receiver (GPS = Global Position System) placed on top of each machine. A base 
reference station is placed in the vicinity of the machines. Control and correction 
information for the machines is transmitted between the base reference station and 
the machines. 

Objects of the invention 

One object of the invention is to provide a control resp. a control indication for a 
ground-preparing machine, which makes possible adequate control of the machine 
with so few as possible measuring units placed outside the machine. 
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Another object of the invention is to produce controlling of a ground-preparing 
machine, where that which is important is the indication of working position and 
working direction of the working part of the machine tools but where the influence 
of the vibrations of the working part, unfavourable environment, obscured positions 
etc. are removed. 

A further object of the invention is to provide a direct position-determining and an 
automatic following of the working portion of the machine's working part during 
the working operation. 

Yet another object of the invention is to provide great flexibility in the setting up of 
a measuring system in relation to the working machine in combination with large 
work regions, high accuracy and distance and/or close indicatable positioning. 

A further object of the invention is to provide a flexible system which is usable for 
measuring of the instantaneous working position and the working direction for 
different types of working machines, e.g. ground-preparing machines, digging 
machines, cranes, etc. 

Yet another object is to provide an instantaneous, continuous and correct position 
and direction indication of a ground-preparing machine during work, even during 
fast movements. 

Summary of the invention 

The above mentioned objects are obtained with a device which has the features 
stated in the characterizing part of claim 1 . Further characteristics and developments 
are stated in the other claims. 

The technical field for the invention relates to a device and a method for determin- 
ing the position of a working part of a tool of a working machine in a fixed ground- 
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basic coordinate system. In order to achieve this without placing equipment on the 
working part, the position for a point on the machine (x,y,z) as well as the inclina- 
tion of the machine (f x and f y in relation to the vertical) and its orientation around a 
vertical axis (f z ) in this fixed coordinate system must be determined. Furthermore, 
the position of the working part in relation to the position of the measured point in a 
local machine-based coordinate system must be known. This position is either fixed 
and known or also different methods can be used for determining the position 
relationship, which for example is based on sensors of e.g. the potentiometer or 
resolver type which are placed at the links which connect the tool to the machine. 
Such methods are known in the prior art and are not dealt with in this connection. 

The invention includes a system with a position-determining apparatus comprising 
at least one detector equipment placed on a suitable position on the working 
machine in order to deterrnine the position of this position in a fixed coordinate 
system, at least one position relationship device to deterrnine the inclination and/or 
orientation of the machine (inclination and orientation are summarized in the 
following with the name "orientation") in the same fixed coordinate system and with 
an accelerometer device. The positional relationship of the working part in relation 
to the detector equipment in a machine-based coordinate system is known in the 
prior art. Furthermore, a calculation device, which with signals from the position- 
determining apparatus and positional relationship device determines the position of 
the working part in the fixed coordination system, is included. The device is also 
characterized in that the position-determining apparatus comprises an orientation- 
measuring device so that the apparatus measures instantaneously both position and 
orientation of said position on the working machine in the fixed coordinate system, 
and that the calculating device converts the measuring result from the position- 
detennining apparatus and the positional relationship device in order to give the 
instantaneous position and orientation of the working part in the fixed coordinate 
system. 
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The position- and orientation-determining apparatus can comprise, on one hand, 
a relatively slow, accurate detenriining device, which at time intervals accurately 
measures the current position and orientation of the machine, and on the other hand 
a fast determining device, which reacts on position and/or orientation changes in 
5 order to calculate and update the calculation between said time intervals. This fast 
determination device in this case only has to be stable for short periods of time 
because a slow drift is corrected through updating from the slower device. 

The relatively slow, accurate position and orientation determination can take place 
1 0 with the help of a stationary measuring station, for example a geodesic instrument 
with automatic target-following or a radio navigation system, for example GPS 
(Global Positioning System) placed in the vicinity of the working machine for 
position-determining in cooperation with the detector device. The inclination can 
also be determined e.g. by inclinometers and the orientation around the vertical axis 
15 e.g. by compass or by a north-seeking gyro. 

The short time-period-stable determining device can thereby comprise an accelero- 
meter device on the machine for measuring the acceleration of the machine in at 
least one direction, preferably in several mutually different directions, whereby the 
20 calculation unit double-integrates the indicated acceleration or accelerations and 
updates the latest calculated result of the position in the fixed coordinate system. 

When a quick detenriination of a change of orientation is needed, preferably a 
further accelerometer or a gyro is used for each axis around which rotation is to be 
25 determined. The signals from these sensors are used, after suitable integration and 
conversion from the coordinate system of the machine to a fixed coordinate system, 
to update the position-determinations for the machine in the fixed coordinate 
system. A suitable way of putting together the information from the slow and the 
fast sensors in an optimal manner is to use Kalmann filtering. 



30 
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Preferably, measuring and calculation are continuously performed at intervals while 
the machine is in operation. The calculating unit calculates after each measuring the 
position, and possibly the direction of working and the speed of working, of the 
working part of the tool, using the latest and earlier calculation results for the posi- 
tion. The calculating unit can also use earlier calculation results in order to predict 
the probable placement, orientation, direction of working and speed, a certain time 
in advance for the working part of the working machine. 

Advantages of the invention 

By the invention a measuring system has been produced which is easy to use and 
which furthermore is relatively cheap. Already existing stations for measuring a 
region can be used for controlling the working machines. This means that special 
equipment for the stations does not need to be bought or transported to the working 
place, especially for use with the invention. 

As it is the position and orientation of the working machine itself which are 
measured, and as the position of the working part is then calculated with the help of 
signals from the positional relationship devices, a system is obtained which can use 
separate control and sensor systems of any type for the machine, especially 
concerning preparation machines and excavators. Sensitive rotation indicators on 
the vibration-working part itself can be avoided. 

Short description of the figures 

The invention is described more closely below with reference to the accompanying 
drawings, where 

Fig. 1 shows schematically an excavator with a first embodiment of a 

measuring system according to the invention, 
Fig. 2 shows a block diagram of an accelerometer device, 
Fig. 3 shows a second embodiment of a system according to the invention, 
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Fig. 4 



shows an embodiment of the position of a reflector on the excavator 
in Fig. 3, 

shows an embodiment of a detector unit used in the measuring system 



Fig. 5A 



according to the invention, 
Fig. 5B shows a first embodiment of a detector for the device in Fig. 5 A, 
Fig. 5C shows a second embodiment of a detector for the device in Fig. 5 A, 



Detailed description of the different embodiments of the invention 
Embodiment 1 : 

According to the embodiment shown in Fig. 1 , a geodesic instrument I is set up on 
a ground area which is to be treated. The instrument 1 is, for example, an electronic 
distance-measuring instrument 2 with an integrated distance and angular measure- 
ment of the type which is called a total station and which is marketed by SPECTRA 
PRECISION AB, i.e. with combined advanced electronic and computer techniques. 
The position and the horizontal angular position of the instrument 1 is first measured 
in the common way well-known for the skilled man. This can, for example, be per- 
formed through measuring against points in the region with predetermined positions, 
e.g. church towers or the like. 

A geodesic instrument gives both the distance as well as the vertical and horizontal 
direction towards a target, whereby the distance is measured against a reflector, e.g. 
of the corner cube type. A geodesic instrument is furthermore provided with a com- 
puter with writeable information for measurings to be performed and for storing of 
data obtained during the measurings. Preferably an unmanned geodesic instrument 
is used for the invention, which means that the instrument automatically searches 



Fig. 6 



shows schematically an excavator with a third embodiment of a 
measuring system according to the invention, 

shows a block diagram for a complete measuring system according to 
the invention, 

shows a picture on a screen in the control cabin of the excavator. 



Fig. 7 



Fig. 8 
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and locks onto and follows an intended target, which can be made of the same 
reflector which is used for the distance measuring or some other active target as 
described later. The geodesic instrument calculates the position of a target in a fixed 
ground-based coordinate system. 

A working machine in the form of a ground-preparing machine, e.g. a ground 
scraper machine, is, for the slower, accurate position measuring in this embodiment, 
provided with a reflector unit 4, e.g. a corner cube prism in a placement on the 
machine which is well visible from the geodesic instrument 1, no matter how the 
machine twists and turns, on the roof of the machine in this case, and with an 
orientation-determining unit 5a,5b and a device 6 comprising at least one accelero- 
meter for acceleration-sensing and possibly a further accelerometer or a gyro unit 
for sensing rotation. 

A corner cube prism reflects back an incident beam in the opposite direction even if 
the angle of incidence to it is relatively oblique. It is important that the reflector unit 
4 does not point a non-reflecting side towards the instrument 1 . It should therefore 
preferably consist of a set of corner cube prisms placed in a circle around an axis. 

The orientation of the machine in a fixed coordinate system in this embodiment is 
determined by the units 5a,5b, which for example contain two inclination sensors 
5a for determining the inclination towards a vertical axis in two perpendicular 
directions and an electronic compass or a north-seeking gyro 5b for determining 
the orientation in a fixed coordinate system, for example in relation to north. 

It is important that the system can follow fast courses of events, as the machine 
during its work can tip if it rides up on a rock or down into a dip. A possibility for 
a short-term-stable, accurate and rapid determination of position and orientation 
changes in the machine-based coordinate system, for subsequent conversion to the 
fixed coordinate system, should therefore be provided. With such a possibility the 
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position and direction changes can be determined in the interval between the slower 
position and orientation determination of the machine via the total station. 

Therefore the accelerometer device 6 is placed on the machine for indicating rapid 
5 movements. This device 6 should preferably sense fast movements and rotation of 
the machine in different directions, in order to give satisfactory functioning. A mini- 
mum requirement is, however, that the device senses the acceleration along an axis 
of the machine, and in this case preferably its normal vertical axis (z-axis) because 
the requirement for accuracy normally is greatest in this direction, where the inten- 
1 0 tion of the ground preparation normally is to provide a certain working level in the 
vertical direction. Preferably, however, the device 6 should sense acceleration 
and/or rotation in relation to three different axes of the machine. 

The acceleration measurers can be of any conventional type whatsoever and are not 
15 described and exemplified in more detail, because they are not part of the actual 
invention. Their output signals are double integrated with respect to time in order 
to give a position change. This can take place in the unit 6 or in a computer unit 20 
(see Fig. 8). The calculated position changes are given in the coordinate system of 
the machine but are converted then to the fixed coordinate system, so that the move- 
20 ments of the machine in the fixed coordinate system all the time are those which are 
continuously shown. These indications take place with such short intervals which 
are suitable for the control system used. 

The geodesic instrument 1 can give absolute determination of the position of the 
25 reflector unit in the fixed coordinate system with a time interval of approximately 
0.2-1 sec, wherein data from the device 6 supports the measuring system there- 
between. 



30 



The ground-working part 7, i.e. the scraper part of the scraper blade 8 of the 
machine 3, is that which actually should be indicated in the fixed coordinate system 
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with respect to position, rotation in horizontal and vertical directions and also 
preferably with respect to its direction of movement and speed of movement. 

The machine's own positional relationship sensor (not shown) gives a basis for 
5 calculating the instantaneous position of the scraper part 7 in the coordinate system 
of the machine. Sensing and calculation of the instantaneous setting of the scraper 
blade in relation to the machine with geometric calculations are well-known arts and 
there do not need to be described more closely. The combination of information 
from the different sensors to a final position and orientation in the fixed coordinate 
10 system suitably takes place in the main computer 20. A suitable method for 

obtaining an optimal combination of the information from the different sensors for 
detemining the actual position and orientation is the use of Kalmann filtering. 

Fig. 2 shows schematically an accelerometer device 6 for sensing along an axis of 
15 the machine and with rotation-sensing around a perpendicular axis. In this way the 
accelerations ai and a 2 are sensed with the accelerometer ACC 1 and ACC2. By 
combining these two measured values and with knowledge of the distance d 
between the accelerometers, rotation and acceleration of some selected point (A) 
can be calculated. Through using three similar sets, the acceleration along and the 
20 rotation around three axes can naturally be determined. As an alternative or 

complement, the rotational changes around one or more axes can be determined 
with the help of gyros. 

Embodiment 2: 

25 The ground-preparation machine 3 in Fig. 3 is, for the slow, accurate orientation 
determination around the vertical axis, in this embodiment provided with two 
reflector units 4a and 4b in a placement on the machine which is easily visible from 
the geodesic instrument 1 . In the embodiment according to Fig. 3 they are placed 
with an essentially fixed placement in relation to each other and the machine. The 

30 possibility of having the reflectors movable between different "fixed" positions, 
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in order to obtain a suitable orientation in relation to the measuring instrument, is 
obvious. Each of them should preferably consist of a set of corner cube prisms 
placed in circle around an axis. 

The machine's three-dimensional placement and orientation in a fixed, or in relation 
to the measuring instrument defined coordinate system is measured through the 
measurement towards the reflector units 4a and 4b, which have a precise or deter- 
minable placement in the coordinate system of the machine. By determining the 
positions of the reflectors in the fixed coordinate system, then the orientation of the 
machine in this coordinate system can be determined, which means that the 
transformation between the coordinate systems is defined. 

The reflector units 4a and 4b in Fig. 3 have each their own sighting indicator 12 and 
13, which give direction information for the geodesic instrument as to the target or 
the reflector to which its instantaneous alignment should be made and for measuring 
against this target. The sighting indicator can be of different types; it is only 
important that it automatically aligns the geodesic instrument to the measuring 
reflector which for the moment is to serve as the target for the measurement. 

The alignment indicators are, however, in the embodiment shown in Fig. 3, light 
elements, preferably provided with a special modulation and wavelength character 
which is separable from the environmental light, and are shown here placed under 
their respective target reflectors and preferably so that their light can be seen from 
all directions. The geodesic instrument 1 is thereby suitably provided, under the 
distance measurer 2 itself, with a seek and setting unit 14, which seeks a light signal, 
having the same modulation and wavelength character as the light elements. Each 
one of the alignment indicators 12 and 13 can suitably consist of several light 
elements arranged in a circle in the same way as the reflectors, in order to cover 
a large horizontal angle. 
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The light elements in 12 and 13 are lit alternatingly with each other in such a rate 
that the seek and setting unit 14 manages to set its alignment towards the light of the 
light elements, and measuring of distance and alignment to its associated targets is 
able to be performed. The measuring is performed in sequence towards the two 
reflector units 4a and 4b. 

Alternatively, three (or more) reflector units with light elements can be placed in 
predetermined positions on the machine, whereby measuring towards these targets 
with calculations gives position, alignment and orientation of the machine in a three- 
dimensional fixed coordinate system. 

Fig. 4 shows another embodiment of a target unit 30, towards which the geodesic 
instrument 1 can measure in order to obtain position data for the machine 3. The 
target unit comprises in this case a disc 31, which rotates around an axis 32 normal 
to the disc. A target, here in the form of a reflector 33, e.g. a ring of reflectors of the 
corner cube type, is mounted near the periphery of the disc 3 1 . What is important 
with this embodiment is that the reflector 33 rotates around an axis 32, wherefore it 
instead can be mounted on a rotating arm (not shown). The detector unit 33 shaped 
as a reflector is consequently movable between positions with determinable posi- 
tions in relation to the working machine, and an indicating unit, e.g. an encoder 
(not shown), continuously indicates the position. 

A further alternative way of determining the orientation of the machine is to use a 
servo-controlled optical unit which automatically aligns with the geodesic instru- 
ment. With e.g. an encoder, the alignment of the optical unit can be read in the 
coordinate system of the machine. An embodiment thereof is shown in Figs. 5A-5C. 
At least one servo-controlled optical unit 26-29 aligns itself with the geodesic 
instrument. In this case the optical unit is built together with the reflector, which 
gives the advantage that it can consist of a simple prism and not a circle of prisms. 
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The units can, however, also be separated. For the optical unit it is appropriate to 
use the measuring beam of the geodesic instrument or a beam parallel with this. 

In the embodiment shown in Fig. 5 A the optical unit 26 is placed beside the 
5 reflector 25 shown in section. The optical unit consists of a lens or a lens system 27 
and a position-sensitive detector 28. The lens/lens system focuses the measuring 
beam on the detector 28, which for example is a quadrant detector as is shown in 
Fig. 5B. The geodesic measuring beam of the instrument 1 can thereby be used also 
for the alignment device if the beam is sufficiently wide. Alternatively, and from the 

10 technical point of view, preferably, the instrument is, however, provided with an 

extra light source, e.g. a laser, which towards the unit 26-28 transmits a narrow light 
beam, which in this case can have a completely different character, for example 
another wave-length, than the measuring beam transmitted towards reflector 25, and 
is parallel with and arranged at the same distance from the measuring beam as the 

1 5 centre line of the tube 26 from the centre line of the reflector 25. 

A third alternative is to place a corner cube prism for alignment of the reference 
station (not shown) and a light source 23 (drawn with dashed lines) up against the 
optical unit (26-28). In this case a reflected beam is obtained from the prism which 
20 is focused on the quadrant detector when the optical unit is correctly aligned to the 
station. 

With the use of a quadrant detector 28 the servo-control can take place such that the 
subdetectors will have so similar illumination as possible. Such detectors are known 
25 in themselves, equally their use in different types of servo-control arrangements 29, 
and therefore are not described more closely. 

The optical unit is movably and control lably mounted on the machine and possibly 
integrated with the reflector. Through the servo-control of the servo-motors (not 
30 shown) the optical unit is aligned so that the signals from the detector 28 are 
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balanced, which means that the unit is orientated in the direction of the measuring 
beam. The alignment in relation to the working machine can be read, for example 
with some kind of encoder, or with some other type of sensing of the instantaneous 
setting positions of the guided servo-motors. 

5 

The above alignment can occur in both horizontal and vertical directions, but the 
complexity is reduced considerably if it is limited to guidance in the horizontal 
direction. This is often sufficient when the inclination of the machine normally is 
minor in relation to the normal plane. In such a case the detecting can be performed 
1 0 with the help of a detector, elongated in the transverse direction, and a cylinder lens 
which collects the radiation within a certain vertical angular region to the detector. 
Because Fig. 5 A shows a cross-section, it also corresponds with this embodiment. 
The detector can be made of, for example, a one-dimensional row of elements of 
e.g. CCD-type, as is shown in Fig. 5C. 

15 

Information on the direction from the geodesic instrument to the position detector, 
which is given by the geodesic instrument, together with the encoder reading which 
gives the orientation of the machine in relation to the geodesic instrument conse- 
quently gives the orientation of the machine in a fixed coordinate system. 

20 

The servo-control of the target reflector means that information is continuously 
received about the alignment of the vehicle in relation to the geodesic instrument 1 . 

Embodiment 3 : 

25 In the above-described embodiments the position measuring has occurred through 
measuring against one or more targets on the measuring object from a geodesic 
instrument 1 . Position-measuring can also occur with the help of radio navigation, 
e.g. GPS (Global Position System), by placing one or more radio navigation 
antennae on the measuring object and one on a stationary station to one side. 

30 
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In the embodiment shown in Fig. 6 there is a radio navigation antenna 50, which 
here is shown receiving signals from a number of GPS-satellites 49, at the periphery 
of a rotating disc 51 on the upper part of an excavator 52. The position of the 
antenna is indicated in a radio navigation receiver 55 in at least two predetermined 
5 rotational positions of the disc 5 1 in relation to the excavator 52. The disc rotates so 
slowly that the antenna position in each rotational position can be indicated with 
accuracy but still so fast that normal movements of the excavator do not signi- 
ficantly influence the measuring result. 

10 A reference station 1 ? with another radio navigation antenna 53 with receiver 54 
is mounted on a station which is placed at a predetermined position outdoors with 
a known position somewhat to the side of the ground which is to be treated. A 
differential position determination is obtained through radio transfers between the 
radio navigation receiver 54 and the calculating unit 20 in the machine 52. The 

15 instantaneous position of the machine is calculated with so-called RTK-measuring 
(Real Time Kinematic). A calculation of this type is in itself well-known and does 
not need to be described more closely. 

The only difference to earlier embodiments is that the position determination against 
20 the target(s) is made with GPS-technology instead of through measuring with a total 
station. For the rest, the orientation determination and determination of fast dis- 
placements and rotations takes place in the same way as described in earlier 
embodiments. 

25 Common block diagram 

Fig. 7 shows a block diagram according to the invention which is applicable to all 
the embodiments. It can be pointed out that with position determination with a 
geodesic instrument, position data for the target is collected in the reference station 
1 and transmitted to the machine via radio link, while in the GPS-case it is correc- 

30 tion data from the receiver 54 which is transferred from the reference station 1 ' to 
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the machine and that position data is produced in the calculating unit 20 starting 
from data from the receivers 54 and 55. 

The calculating unit 20 consequently calculates through combining data from the 
5 reference station 1 and, in the GPS-case, the receiver 55 together with data from the 
orientation sensors 5, accelerometer device 6 and sensors for relative position 11, 
the instantaneous position of the scraper blade in the fixed coordinate system, i.e. 
converted from the coordinate system of the machine. The sensors for relative 
position 1 1 can for example be encoders or potentiometer sensors connected to the 
1 0 links which join the working part of the machine. The calculating unit 20 is 
preferably placed in the machine. 

The desired ground preparation in the fixed coordinate system is programmed into 
either the computer 20 of the geodesic instrument 1 or preferably of the machine 3. 

1 5 This is equipped with a presentation unit 9, preferably a screen, which presents to 
the operator of the machine (not shown), on one hand, how the machine 3 and its 
scraper blade 8 are to be manoeuvred based on its instantaneous existing position 
and, on the other hand, its instantaneous deviation from the desired manoeuvring. 
Alternatively and preferably an automatic guidance of the working part to the 

20 intended height and orientation is performed with the help of the control equipment 
12 consisting of, for example, hydraulic manoeuvring means which are controlled 
by the unit 20. 

The machine operator must occasionally deviate from the closest working pattern 
25 because of obstacles of various types, such as stones or the like, which are not 

included in the geodesic instrument's programmed map of the desired structure of 
the ground preparation region. 



30 



It is also possible to show a programmed map of the desired preparation and of 
the existing position and direction of movement of the scraper part 7 on the map. 
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The information between the geodesic instrument 1 and the machine 3 can be sent 
wirelessly in both directions, as is shown by the zigzag connection 10. The com- 
puter in one or the other of these units can be chosen to be the main computer which 
performs the important calculations usable for the work of the machine 3 with the 
scraper blade, but preferably this is done in the unit 20. The most important here is 
that the calculation of the position and orientation of the scraper blade is performed 
in the fixed coordinate system, no matter where it is, that the geodesic instrument 
and electronic units in the machine have data-transferring connections with each 
other, and that the machine operator is given an easily understood presentation of 
what is to be done and what is finished. 

Fig. 8 shows an example of a picture which can be presented to the machine 
operator on the presentation unit 9. A picture of a scraper blade with an alignment 
mark is superimposed on a map with the desired profile of the ground preparation 
region, wherein the picture of the scraper blade moves over the map as working 
progresses. The presentation unit 9 can be split and can also show a profile picture 
with the scraper blade placed vertically over or under the desired ground level and 
with the height difference with respect to this being given. 

The actual ground level does not need to be shown. However, it can be suitable 
to show parts of the ground with the desired height clearly in the picture to the 
machine operator so that he knows where to perform his work. In this case it is 
possible to have a function, which gives parts of the ground with a small difference 
within a predetermined tolerance level between the actual and the desired level, 
a predetennined colour e.g. green. 

It is also possible, e.g. as shown with dashed lines in the map, to show a shadow 
picture of the scraper blade in order to indicate that it has not yet arrived at the right 
level. In this case it looks like the scraper blade is hovering over the ground and the 
machine operator obtains a clear indication of how deep the machine must scrape in 



WO 99/28565 




PCT/SE98/02167 



*9 

order to get the shadow picture to unite with the picture of the scraper blade. It is 
suitable in the invention that the desired levels for the ground preparation which are 
shown on the map, wherefore it is the position of the shadow picture which indicates 
where the scraper blade 7 is in the normal to the plane of the map. In this connection 
5 it is of no interest to show the actual ground structure on the map. 

Calculation of position and rotation of the machine both in vertical and horizontal 
direction is performed in the fixed coordinate system as well as subsequent calcu- 
lation of the instantaneous position and rotation angles of the scraper blade after 
1 0 conversion from the coordinate system of the machine to the fixed coordinate 

system. Subsequently there follows a new sequence with the same measurements 
and calculations with subsequent calculation of the scraper blade's displacement 
from the previous measurement, whereby the direction and speed of the blade are 
obtained and presented on the presentation unit 9. 

15 

These measurement sequences are repeated during the machine's scraper work, 
whereby the machine operator the whole time during the working progress obtains 
instantaneous data concerning the scraper blade's position, alignment, direction of 
displacement and speed in the fixed coordinate system, and consequently obtains an 
20 extremely good idea of how the work is progressing compared to the desired ground 
preparation, and how the machine is to be manoeuvred. 

The geodesic instrument can only perform its alignments and measurements in a 
relatively slow speed in the fixed coordinate system. The accelerometer device is 

25 used in order to update the measuring results in the intermediate times. A special 
advantage of this updating function between the upgrades with the geodesic 
instrument is that, because the measurement towards the two measurement targets 
4a and 4b in Fig. 3 cannot be performed simultaneously, it is possible, with the 
updating, to achieve that the delay between the sequential measurements towards 

30 the reflectors can be compensated for. 
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Through the machine's direction of displacement and speed being calculated 
continuously, it is also convenient to calculate a predicted position and orientation 
for both the machine and the working part a certain time in advance, based on 
earlier calculating data. How such calculations are performed with the help of the 
5 latest and earlier calculated data is obvious for the skilled person and is therefore 
not described more closely. 

Many modifications of the embodiments shown are possible within the scope which 
is given by the accompanying claims. It is consequently possible to have mixed 

1 0 designs with both prisms and radio navigation antennae as position detector units. 
For example, the position and rotation alignment of a geodesic instrument can be 
determined with the help of one or more radio navigation antennae, for example one 
on the geodesic instrument and one at a distance from this. Other types of working 
machines than those shown, where one wants to have continuous information on 

1 5 position, angular position and direction of work during working progress, such as 
e.g. cranes, dredges or the like, are extremely suitable to be provided with the 
invention. Each stated calculation unit is suitably a computer or a subroutine in 
a computer, as is common nowadays. 
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Claims 

1. Device for determining the position for a working part of a tool on a working 
machine with a position-determining apparatus (l,4,5a,5b,6;l,4a,4b,5a,5b,6; 
3 1 ,33; 49,50,5 1 , 1 ',53) comprising at least one detector equipment (4,5a,5b,6; 
4a,4b,5a,5b,6; 31,49,50,51,53) placed at a designated place on the working 
machine (3;52) in order to determine the position of this place in a fixed coordi- 
nate system, and with at least one position relationship device (1 1) in order to 
determine the positional relationship of the working part relative to the detector 
equipment in a machine-based coordinate system, and a calculating device (20) 
which with signals from the position-determining apparatus and the positional 
relationship device calculates the position of the working part in the fixed coordi- 
nate system, characterized in that the position-determining apparatus comprises 
an inclination- and orientation-measuring device (5a,5b,20;4a,4b,20;31,20;51,20) 
so that the apparatus instantaneously measures both the position as well as the 
orientation of said place on the working machine in the fixed coordinate system, 
and that the calculating device (20) converts the measuring result from the 
position-determining apparatus and the positional relationship device in order to 
give the instantaneous position and/or orientation of the working part in the fixed 
coordinate system. 

2. Device according to Claim 1, characterized in that the position-determining 
apparatus comprises at least one detector unit (4), fixedly placed on the working 
machine, and a north-seeking unit (5b), such as a north-seeking gyroscope or an 
electronically readable compass, for instantaneous sensing of the direction of the 
working machine in relation to north. 

3. Device where the position-determining apparatus comprises a stationary 
measuring station (1 ;T) placed in the vicinity of the working machine for 
determining the position in cooperation with the detector device, in accordance 
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with Claim 1, characterized in that the position- and orientation-determining 
apparatus comprises either at least two detector units (4a,4b) arranged in fixed 
positions relative to the working machine, which in cooperation with the 
stationary station give positions fixed in space for their placements and the 
mutually measured positions of which give the orientation in space for the part of 
the working machine where they are placed, or at least one movable detector unit 
(33;50) movable between positions with determinable positions in relation to the 
working machine. 



4. Device according to Claim 3, characterized in that the position detector unit 
(33;50) is rotatable around an axis (32) placed at a distance therefrom in relation 
to the working machine, whereby measurement towards the position detector unit 
is indicated when it reaches detemiined angular positions around the axis in 
relation to the working machine. 

5. Device according to Claim 1, characterized by at least one rotatably mounted 
and controllable optical unit (26-28,23) placed on the working machine, which 
optical unit aligns itself towards the stationary measuring station with the help of 
ekher the measuring beam of the stationary station or a beam parallel with this 
beam or a beam transmitted from the optical unit and reflected in a prism in the 
stationary station, whereby the orientation of the optical unit relative to the 
working machine is indicated and transmitted to the calculating unit (20) for 
determination of the orientation of the working machine in the fixed coordinate 
system. 



. Device according to any of the previous claims, characterized in that each 
position detector unit is at least one radio navigation antenna (50,53) with 
receiver. 
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7. Device according to any of Claims 1-5, characterized in that the position- 
determining apparatus comprises a geodesic instrument (1 ;1') with target-seeking 
function, placed at a distance from the working machine (3) and measuring 
against at least one target, e.g. a reflector, on the working machine. 

5 

8. Device according to Claim 7, characterized in that each target (4a,4b) is 
provided with an alignment indicator (12,13), which gives alignment indications 
for the geodesic instrument concerning the target towards which its instantaneous 
target-seeking is to be made and for measuring towards this target. 

10 

9. Device according to any of the previous claims, characterized in that the calcu- 
lating device (20) is provided with a stored map with the desired topography of 
an area which is to be treated, and calculated data for the working part for 
position and angular positions relative to the map are presented on a presentation 

15 unit (9) (Fig. 8). 

10. Device according to any of the previous claims, characterized in that the 
position- and orientation-determining apparatus comprises partly a relatively 
slow, accurate determining device (l,4;l,4a,4b;53,50,51), which at time intervals 

20 accurately measures the actual position and orientation of the machine, and partly 

a relatively slow fast determining device (ACC;ACC1,ACC2;6), which reacts on 
position and/or orientation differences to earlier detennination or determinations 
in order to calculate and update the determination between the said time intervals. 

25 11. Device according to Claim 10, characterized in that the relatively fast 
determining device comprises at least one accelerometer device (6;ACC1 ; 
ACC1,ACC2) on the machine for measuring the acceleration of the machine in at 
least one direction, preferably in several mutually different directions, whereby 
the calculating unit (20) integrates the indicated acceleration(s) and updates the 

30 latest calculation result of the position in the fixed coordinate system. 
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12. Device according to Claim 10, characterized in that the relatively fast 
determining device comprises at least one rotation-indicating device (6) for 
rotation around at least one axis of the machine. 

13. Device according to any of the previous claims, characterized in that the 
calculating unit (20) uses earlier calculation results to calculate the probable 
position, orientation, direction of work and speed a certain time in advance for 
the working part of the working machine. 

14. Method for determining the position for a working part of a tool on a working 
machine, whereby the position of the working machine is determined in at least 
one defined place on the working machine in a fixed coordinate system, at the 
same time as the positional relationship relative to the defined position is 
determined in a machine-based coordinate system, and the position of the 
working part is calculated in the fixed coordinate system, characterized by 
measuring instantaneously both the position and the orientation of said position 
on the working machine in the fixed coordinate system, and calculating of the 
instantaneous position and/or orientation in the fixed coordinate system with the 
help of the result of the instantaneous measurement. 

15. Method according to Claim 14, characterized by fixed placement on the 
working machine of at least one detector unit (4) and a north-seeking unit (5b), 
such as a north-seeking gyroscope or an electronically readable compass for 
instantaneous sensing of the direction of the working machine in relation to north. 

16. Method, where the position-determination takes place with the help of a 
stationary measuring station (1 ;1 ') placed in the vicinity of the working machine 
for determining the position in cooperation with the detector device, according to 
Claim 14, characterized in that the position- and orientation-determination takes 
place either against at least two detector units (4a,4b) placed in fixed positions 
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relative to the working machine which in cooperation with the stationary station 
gives positions fixed in space for their positions and the mutually measured 
positions of which give the orientation in space for the part of the working 
machine where they are placed, or against at least one movable position detector 
5 unit (33;50), which can move between positions with defined positions in relation 

to the working machine. 



17. Method according to Claim 16, characterized by rotation of the position 

detector unit (33;50) around an axis (32) placed at a distance from it in relation to 
10 the working machine; measuring against the position detector unit when it takes 

up determinable angular positions around the axis in relation to the working 
machine. 



18. Method according to Claim 14, characterized by rotatable mounting of at least 
15 one controllable optical unit (26-28,23) on the working machine; alignment of 

the optical unit to the stationary measuring station with the help of either the 
measuring beam of the stationary station or a beam parallel with this beam or a 
beam transmitted from the optical unit and reflected in a prism on the stationary 
station; indication of the orientation of the optical unit in relation to the working 
20 machine; calculation for determining of the orientation of the working machine 

in the fixed coordinate system. 



19. Method according to any of Claims 14-18, characterized in that the 

instantaneous measuring of both position and orientation is performed with the 
25 help of at least one radio navigation antenna (50,5 1) with receiver. 



20. Method according to any of Claims 14-18, characterized in that the 

instantaneous measuring of both position and orientation is performed with the 
help of a geodesic instrument (1 ;1') with target-seeking function, placed at a 
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distance from the working machine (3) and measuring against at least one target, 
e.g. a reflector, on the working machine. 

21. Method according to Claim 20, characterized by direction-indication for the 
5 geodesic instrument as to the target towards which its instantaneous target- 
seeking is to be performed for measuring against this target. 

22. Method according to any of Claims 14-21, characterized by storing of a map 
with desired topography of a region which is to be processed in a calculating 

1 0 device, and calculating of data for the working part and presentation thereof as 

position and angular positions relative to the map, on a presentation unit (9) 
(Fig.8). 



23. Method according to any of the previous claims, characterized in that the 
1 5 position and orientation determination is performed partly with a relatively slow 

determination in order to measure, at time intervals, the actual position and /or 
the orientation of the machine, and partly with a relatively fast determination 
(ACC1, ACC2,6), which reacts to position and/or orientation differences relative 
to earlier deterrnination(s) in order to calculate and update the deteraiination 
20 between the said time intervals. 



24. Method according to Claim 23, characterized by, at the relatively fast 
detenriination: 

acceleration-measuring in at least one direction, preferably in several mutually 
2 5 different directions ; 

integration of the indicated acceleration(s); and 

updating of the latest calculation result of the position and/or the orientation in the 
fixed coordinate system. 
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25. Method according to Claim 23, characterized in that, at the relatively fast 
determination, at least one rotation-indication is performed for rotation around at 
least one axis of the machine. 

5 26. Method according to any of Claims 14-15, characterized by calculation, with 
the help of earlier calculation results, of probable position, orientation, working 
direction and speed a certain time in advance for the working part of the working 
machine. 
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